#include "arm_control.h"
#include <thread>


ArmControl ac;


void client(){
    const unsigned short SERVERPORT = 5000;
    const char* SERVER_IP = "192.168.1.100";
    int sock=ac.connect_to_robot(SERVER_IP,SERVERPORT);
    if(sock==-1)return;

    float angle[7]={0};
    angle[0]=1;
    float pose[7]={0};
    pose[0]=1;


    while(1){
        //ac.client_get_data();
        ac.print_status_now();
        sleep(0.5);

        //ac.set_l_angle(angle);
        sleep(0.5);
    }
}

int main(){

    thread t2(client);
    t2.join();



    return 0;
}

